Trajectory Optimization For Robot Manipulators